Ch12 Slam For Robotics - Iterative Closest Point Algorithm